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温室 移动 机 器 人 复合 栅 格 地 图 构建 方法 研究 “ 
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(常州 大 学 a. 城市 轨道 交通 学 院 ;b. 机 器 人 研究 所 ,江苏 常州 213164) 


摘 要 : 针对 温室 环境 中 机 器 人 依靠 自身 携带 的 传感器 无 法 获取 全 面 的 环境 信息 ， 从 而 常 导 致 路 径 规 划 错 误 的 问题 ， 
nn 利用 无 线 传 感 器 网 络 定 时 采集 
对 机 器 人 通过 性 有 影响 的 温度 、 湿 度 环境 信息 , 并 发 送 给 机 器 人 ; 其 次 ， 当 温度 或 湿度 数据 的 变化 浴 达 到 设 定 辣 值 时 ， 

机 器 人 利用 阀 值 分 割 和 插值 法 分 别 建立 温度 和 湿度 栅 格 地 图 ; 最 后 ， 将 温度 棚 格 地 图 、 湿 度 栅 格 地 图 和 室内 障碍 物 物 
栅 格 地 图 相 结合 ， 构 建 动态 更 新 的 复合 栅 格 地 图 。 经 测试 ， 采 用 常规 A* 算 法 规划 路 径 时 ， 基 于 环境 数据 变化 率 阅 值 设 
定 为 +10% 的 复合 栅 格 地 图 的 成 功率 和 完成 时 间 ， 分 别 是 基于 普通 栅 格 地 图 成 功率 的 2.5 倍 ， 和 1.05 倍 。 结 果 表明 ， 复 
合 栅 格 地 图 能 提高 路 径 规 划 的 成 功率 ， 并 且 不 会 由 于 动态 更 新 复合 栅 格 地 图 ， 导 致 机 器 人 响应 时 间 明 显 增加 ， 实 时 性 
能 满足 系统 的 实际 需求 。 
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Research on construction of composite grid map for mobile robot in greenhouse 
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Abstract: A mobile robot based on a normal grid map could not obtain the comprehensive environmental information in a 
greenhouse because of the less number and limited location of carried sensors. An incorrect planning path may arise. The system 
adopted a way to build a composite grid map based on the comprehensive environmental information in greenhouse. Firstly, 
wireless sensor network regularly collected data of temperature and humidity and sent them to the robot. These data had heavy 
impacts on mobile robot’s passing through in greenhouse. Secondly, when the rate of change of temperature or humidity data 
reached the threshold, the system used the method of threshold segmentation and interpolation to establish the grid maps for 
temperature and humidity respectively. Finally, the system combined the grid map for temperature, the grid map for humidity 
and the grid map for interior material barrier in a greenhouse to build a dynamically updated composite grid map. After testing, 


when the system adopted the A * algorithm, the rate of success to avoid area of high temperature and high humidity based on 


the composite grid map at threshold of + 10% was 2.5 times to normal grid map. The time of completion was 1.05 times to 
normal grid map. The results show that the composite grid map can improve the success rate of the path planning and the robot 
does not meet the problem of slow response of the robot due to the dynamic updating of the composite grid map. The real-time 
performance satisfies the actual requirements of the system. 


Key Words: greenhouse; mobile robot; grid map; threshold segmentation; wireless sensor network 


0 引言 移动 机 器 人 的 应 用 技术 ， 己 经 做 了 许多 研究 ， 其 中 机 器 人 的 
主导 航 方 法 是 重点 研究 内 容 之 一 。 
det 自动 化 技术 的 一 种 集中 体现 ， 主 要 人 工 设 置 导 航标 志 是 温室 移动 机 器 人 可 采用 的 一 种 引导 
用 来 在 温室 环境 中 搬运 、 采 摘 、 精 确 施 肥 等 方面 的 工作 ， 有 利 。 主导 航 的 方法 。 有 的 是 在 机 器 人 将 要 移动 的 道路 上 铺设 引导 磁 
于 提高 劳动 es 降低 生产 成 本 。 目 前 ， 国 内 外 学 者 针对 温室 。 条 ， 移 动机 器 人 通过 感应 ， 按 照 既定 路 线 前 进 或 后 退 ， 到 达 
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易 人 ， 副 教授 ， 博 士 ， 主 要 研究 方向 为 机 器 人 控制 、 
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的 地 。 有 的 则 是 直接 在 温室 的 道路 上 铺设 专用 轨道 ， 用 于 机 器 。” 线 局 域 网 ， 将 数据 发 送 给 监控 中 心 的 通信 服务 器 。 另 一 方面 ， 
人 的 往返 移动 ， 此 种 方法 完全 避免 了 移动 机 器 人 与 温室 中 的 作 “移动 机 器 人 接 到 移动 指令 后 ， 即 生成 地 图 ， 并 进行 定位 。 当 自 
物 发 生 碰撞 的 可 能 ， 安 全 性 很 高 。 以 上 两 种 方法 所 实现 的 导航 。“ 身 位 置 、 目 的 地 位 置 和 地 图 都 具备 之 后 ， 采 用 路 径 规划 算法 ， 
均 有 可 靠 性 高 、 移 动 速度 快 等 优点 ， 但 其 实现 起 来 将 会 均 会 增 ”确定 一 条 全 局 最 优 路 径 .移动 机 器 人 运动 控制 器 生成 控制 命令 ， 
加 成 本 ， 特 别 是 铺设 专用 轨道 的 方法 ， 只 适合 于 一 些 超大 型 的 机 的 驱动 器 最 终 实现 机 器 人 的 移动 。 
温室 [5 。 监控 中 心 单 元 为 上 层 单 元 ， 由 通信 服务 器 、 数 据 库 服务 器 
栅 格 地 图 (grid map ) 是 机 器 人 自主 导航 中 常用 的 一 种 环境 和 Web 服务 器 组 成 。 通信 服务 器 是 下 层 数据 上 传 ， 更 高 层 控制 
地 图 ， 是 将 传统 的 几何 地 图 离散 化 表示 ， 用 栅 格 将 目标 区 域 分 。 命令 下 传 的 中 间 层 。 通 信服 务 器 采用 多 线程 机 制 ， 实 现 移动 机 
制 成 连续 的 区 域 。 栅 格 通常 为 正方 形 ， 大 小 一 致 。 根 据 障碍 物 。 器 人 与 通信 服务 器 、 远 程控 制 客户 与 通信 服务 器 、 通 信服 务 器 
的 位 置 ， 将 其 所 对 应 的 棚 格 赋值 ， 表 示 占 用 情况 。 栅 格 地 图 表 与 数据库 服务 器 之 间 的 Sodket 通信 数据 库 服务 器 存储 温室 的 
示 清 晰 、 直 观 应 用 广泛 ， 也 常 被 应 用 在 温室 环境 中 的 机 器 人 自 “环境 数据 温度、 湿度、 光照 度 、COs 量 和 含 氧 量 等 。 数 据 库 
主导 航 中 四。 we 
人 工 设置 导航 标志 的 方法 需要 改造 温室 的 现 有 环境 ， 增 加 信息 。 
了 成 本 ， 通 用 性 不 好 ， 在 实际 应 用 中 使 用 不 多 。 目 前 ， 温 室 环 远程 单元 为 系统 最 高 层 用 户 ， 有 远程 浏览 客户 和 远程 控制 
境 下 的 栅 格 地 图 的 应 用 ， 通 常 只 考虑 温室 内 的 实际 障碍 物 所 构 “客户 2 类 。 远程 浏览 客户 通过 各 种 浏览 器 均 可 直接 访问 Web 服 
成 的 普通 栅 格 地 图 ， 和 机 器 人 自身 而 忽略 如 温度 、 湿 度 等 其 他 务 器 ， 以 图 形 界面 的 形式 显示 数据 。 远 程控 制 客户 需要 安装 客 
因素 ， 或 是 在 机 器 人 运动 时 ， 停 止 一 些 对 机 器 人 造成 不 利 影响 。” 户 端 软件 ， 通 过 Socket 通信 与 监控 中 心 的 通信 服务 器 联系 ， 远 
的 工作 ， 如 喷灌 、 加 热 等 9]。 前 一 种 方法 无 法 获得 全 面 环境 信 ”” 程 客户 端的 控制 命令 由 通信 服务 器 接收 ， 然 后 由 通信 服务 器 控 
息 ,可 能 会 导致 路 径 规划 错误 ,而 后 一 种 方法 显然 缺乏 灵活 性 ， ” 制 机 器 人 。 系 统 配 置 通信 服务 器 的 目的 是 避免 远程 单元 客户 直 
自动 化 程度 低 ， 不 利于 提高 效率 。 本 文采 用 棚 格 地 图 与 外 部 传 。“” 接 控制 移动 机 器 人 ， 这 种 设置 中 间 层 的 架构 大 大 提高 了 系统 的 
感 器 系统 相 结合 的 方案 ， 利 用 无 线 传感器 网 络 定时 监测 环境 信安 全 性 。 本 文 将 重点 讨论 温室 环境 中 ， 复 合 棚 格 地 图 的 构建 方 
息 ， 将 可 能 会 对 机 器 人 造成 损害 的 高 温 、 高 湿 环 境 信息 ， 引 入 法 。 
到 棚 格 地 图 中 ， 构 建 复 合 棚 格 地 图 ， 既 能 保证 地 图 信息 的 全 面 有 
准确 ， 又 能 提高 温室 移动 机 器 人 的 工作 效率 。 2 ”构建 温室 环境 复合 栅 格 地 图 
1 ”系统 结构 A en a 
先 获取 环境 信息 ， 然 后 选取 对 机 器 人 移动 有 重大 影响 的 关键 环 
本 系统 由 3 部 分 构成 ， 分 别 是 工作 现场 单元 、 监 控 中 心 单 。“” 境 信息 ， 并 对 离散 的 关键 环境 信息 建立 连续 模型 ， 再 对 各 关键 
元 和 远程 单元 ， 系 统 结构 如 图 1 所 示 。 环境 信息 ， 使 用 阔 值 和 单元 分 解 分 别 建立 棚 格 地 图 ， 最 后 将 各 
0 ， ”个 棚 格 地 图 相 结 合 ， 得 到 复合 机 格 地 图 。 
' 1) 环境 信息 获取 
人 | 利用 传感器 系统 获取 温室 各 处 多 种 离散 的 环境 信息 ， 如 温 
Ts I | 度 、 湿 度 、 光 照度 、CO, 量 和 含 氧 量 等 。 温 宝 中 温度 过 高 或 者 
| | 湿度 过 大 的 区 域 ， 都 对 移动 机 器 人 本 身 有 不 利 的 影响 ， 应 避免 
和 | | 进入 该 区 域 。 因 此 ， 在 众多 的 环境 信息 中 ， 温 度 和 湿度 为 关键 
人 EL 环境 信息 ,将 会 直接 影响 到 环境 地 图 的 建立 .如 果 在 室外 环境 ， 
工作 现场 单元 监控 中 心 单元 “远程 单元 
下 则 地 形 的 坡度 信息 ， 应 该 成 为 关键 环境 信息 之 一 
2) 关键 环境 信息 建 模 
工作 现场 单元 由 无 线 传感器 网 络 和 移动 机 器 人 组 成 。 无 线 建 模 的 目的 是 将 原本 离散 的 关键 环境 信息 ， 通 过 某 种 方法 
传感器 网 络 负 责 采集 温室 实时 环境 数据 。 移 动机 器 人 则 根据 生 。” 变 成 连续 的 ， 覆 羡 整 个 ae 
成 的 环境 地 图 自主 移动 到 目的 地 ， 完 成 搬运 、 采 摘 等 任务 。 同 。 标 区 域内 ， 根 据 任 一 点 的 坐标 ， 即 可 求 得 该 点 的 环境 参数 值 ， 
时 ， 移 动机 器 人 还 承担 将 温室 环境 信息 中 转 到 监控 中 心 单元 的 。 ”为 地 图 的 构建 做 好 准备 。 
任务 。 系统 使 用 三 角形 插值 法 ， 根 据 此 方法 ， 对 已 知 的 空间 点 进 
工作 现场 单元 的 工作 过 程 ， 一 方面 ， 无 线 传感器 节点 每 隔 。“ 行 划分 ， 所 有 三 角形 互 不 交叉 ， 且 使 任何 一 个 三 角形 的 最 小 内 
1s 采集 一 次 温室 环境 参数 ， 并 采用 单 跳 或 者 多 跳 的 方式 传递 给 。 角 为 所 有 可 能 的 划分 中 最 大 ， 这 样 可 以 保证 误差 最 小 。 对 于 三 
安装 在 移动 机 器 人 上 的 网 关节 点 , 网 关节 点 通过 USB 接口 将 数 。 ”角形 除 3 个 顶点 外 的 任意 坐标 (xy)， 其 z 值 根据 插值 法 进行 
据 送 给 移动 机 器 人 ， 移 动机 器 人 再 通过 由 无 线路 由 器 搭建 的 无 “估算 。 图 2 假设 为 已 经 划分 好 的 某 三 角形 ，A,B,C 为 三 角形 的 


录用 稿 


顶点 ， 数 据 是 已 知 的 ， 现 在 要 求 出 其 内 部 任意 点 D 处 的 ZzZ 值 。 


B (x2,y2,72) 


A (x1,y1,z1) 
C (x3,y3,23) 
图 2 9 形 插值 
空间 向 量 有 如 下 关系 : 
4Cx45。4D=0 (1) 


则 有 


13-X y3—y]l z3—zl 
det| x2—x1 y2—yl z2-zl|=0 (2) 
XxX—xXl y-yl z-zl 


二 将 式 (2) 行列 式 展开 可 得 


3_y 23-al 2 | 
ar Gs? Ce 3 -0-0 > | 


7Z= y2—y1 z2-zl XxX2—xl z2—zl 
—Xxl —yl 
Ge Xx3—Xl y3—y 
Xx2—xl y2—yl 

G3) 

利用 式 (3) 可 求 出 三 角形 中 , 任 一 点 的 z 值 , 当 任 意 点 (x,y) 


联 
I 


攻 选 取 时 ， 就 可 构成 一 个 连续 的 曲面 。 
3) 建立 复合 栅 格 地 图 
a 将 温室 地 表 平 面 逻辑 上 划分 成 大 小 一 致 的 栅 格 ， 通 常 为 
方形 ， 栅 格 边 长 应 大 于 移动 机 器 人 最 宽 处 ， 即 移动 机 器 人 能 
十 栅 格 。 
b) 利 用 式 (4) 判断 栅 格 对 应 的 环境 量 ， 是 否 有 利于 移动 机 
器 人 运动 的 通行 , 若 栅 格 (x,y) 处 的 zw. 超过 某 阔 值 Zo， 则 认 
为 不 利 ， 则 此 栅 格 逻辑 上 被 赋值 1， 表示 被 占用 ; 反之 , 被 赋值 
为 0， 表 示 可 以 通行 ， 当 有 多 个 环境 量 时 ， 则 需要 在 相同 的 让 
格 划分 的 基础 上 ， 分 别 求 出 不 同 环 境 信 息 时 ， 各 个 栅 格 的 占用 
情况 。 


EF 


(4) 


else 


a if (ZY) 22) 


c) 根 据 所 得 的 多 种 环境 信息 下 的 栅 格 地 图 , 按 式 (5) 将 其 
县 加 起 来 ， 获 得 最 终 的 复合 栅 格 地 图 。 
Ty)=GH GHG GCC) GO) 
式 (5) 中 7(x,y) 表示 复合 栅 格 逻辑 值 ，G (x, y) 表示 第 n 
种 环境 信息 下 的 栅 格 逻辑 值 。 


3 ”构建 地 图 实例 


3.1 环境 信息 获取 

本 系统 采用 无 线 传感器 网 络 获取 温室 内 的 环境 信息 ， 其 中 
温度 、 湿 度 参 数 将 会 被 用 于 制作 环境 地 图 。 温 室 长 100m， 宽 
40m, 按 任 一 行 和 列 的 相 邻 传感器 节点 间隔 均 为 20m 规律 布置 ， 


传感器 节 


传感器 节点 通常 采 
其 调理 电路 ,本 系统 中 的 
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点 布置 如 图 3 所 示 ， 左 下 角 的 坐标 为 (0,0)。 


加 3 ”传感器 节点 布置 
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和 含 氧 量 


等 。 上 层 结 构 采 


E 线 收发 
备 、 增 强 


成 [cal。 在 TI 公司 


慨 结 构 ， 底 层 为 各 种 传感器 设备 及 


传感器 有 温度 、 湿 度 、 光 照度 、CO; 量 
j TI (texas instruments ) 公司 CC2530 


芯片 ， 该 芯片 是 一 个 功能 强大 的 微 处 理 器 ， 由 存储 设 


型 8051 处 理 器 利 


I 支持 ZigBee 协议 的 无 线 收发 单元 构 
出 的 Z-STACK 开发 包 的 基础 上 ， 能 够 较 


为 容易 的 开发 出 传感器 节点 、 路 由 节点 和 网 关节 点 的 程序 [1。 


三 种 节点 


程序 加 以 
传 感 
节点 将 数 


节点 所 在 


mm 


又 分 ， 通 


的 硬件 完全 机 


器 节点 每 1 
据 传 递 给 机 


位 置 的 环境 信息 。 


由 于 
出 现 剧烈 


殊 情况 下 


3.2 关键 环境 信息 
己 知 的 温度 和 湿度 离散 信息 , 在 MATLAB 平台 , 根据 
写 程序 ， 即 可 建立 温度 、 湿 度 的 连续 模型 ， 如 图 4 所 
图 4 (a) 表示 温度 模型 ， 图 4 (b) 表示 湿度 模型 。 


根据 


式 (3) 编 


示 ， 其 中 


大 部 分 时 间 内 ， 温 室 
变化 ,在 测试 
了 加 热 炉 ， 在 和 


构建 地 图 的 效果 ， 


建 模 


晶 同 ， 仅 通过 是 否 连接 传感器 和 运行 不 同 
性 很 强 。 
s 采集 一 次 数据 ， 发 送 给 网 关节 点 ， 网 关 


器 人 ， 此 时 的 数据 是 离散 的 ， 表 示 传 感 器 


的 温度 和 湿度 均 表 现 稳 定 ， 不 会 


Pp, 为 了 体现 特殊 情况 , 在 坐标 为 (80,0) 
E 标 为 《60，20) 处 开启 喷灌 头 ， 模 拟 特 
以 及 移动 机 器 人 的 运动 


情况 。 


Z/ %RH 


40 5 
8 0 0 10 20 30 
X/m 


6 0 70 80 gO 100 
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温度 、 湿 度 连 续 模 型 
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从 图 4 (a) 模型 中 得 出 ， 坐 标 〈80,0) 处 温度 最 高 ， 随 着 


距离 的 增加 , 温度 逐渐 降低 , 可 以 看 出 , 即使 在 20m 的 距离 上 ， e 故 医 面 硬 而 面 而 加 隙 本 图 量 而 国 轩 加 加 面 疝 而 团 机 轩 症 | 
也 明显 受到 热 辐射 的 影响 而 温度 升 高 。 从 图 4 (b) 模型 得 出 ， > 
坐标 〈60,20) 处 湿度 最 大 ， 随 着 距离 的 增加 ， 湿 度 也 呈 下 降 趋 十 5 中 
势 。 但 湿度 的 影响 范围 较 小 ， 超 过 20m 的 距离 ， 湿 度 几 乎 不 受 2 
影响 中 
4 加 加 加 加 
3.3 建立 复合 栅 格 地 图 0 8 16 24 32 40 Sr 64 72 80 88 96 
本 系统 所 使 用 的 移动 机 器 人 尺寸 为 : 机 体 宽度 485mm， 总 
a 
长 494mm, 高 度 49$Smm， 为 了 保证 机 器 人 能 够 通过 ,并 留 有 余 
地 ， 将 温室 地 表 平面 逻辑 上 划分 成 边 长 为 4m 的 正方 形 栅 格 ， 0 TTT TT 
如 图 5 所 示 。 0 | 
24- 
E onl 
100m 大 ?8 图 
k 让 1 
了 8 
温室 平面 让 
0 8 16 24 32 40 4 5 64 72 80 88 96 
40m 
(b) 
40; | 和 
图 5 温室 平面 栅 格 lt 加 故国 | | 
28- 本 | ”| | 
于 栅 格 是 一 个 平面 ， 若 仅 使 用 某 一 点 (x,y) 代替 整个 机 E24 
格 平面 ， 再 利用 式 (3) (4) 确定 顶 格 的 逻辑 值 ， 有 可 能 会 造成 3 
栅 格 逻辑 值 误 判 ， 当 棚 格 面积 越 大 ， 发 生 误 判 的 概率 也 越 大 。 4 pm 
因此 ， 在 图 6 中 栅 格 的 顶点 和 各 边 中 间距 离 取 点 ， 分 别 为 5 
a,b.…..h ， 其 坐标 分 别 对 应 为 (ax, ay), (Dx, by),......, (hx, hy) 。 式 (4) 
C 
可 相应 变化 为 四 
图 6 温度 、 湿 度 和 障碍 物 栅 格 地 图 
Go wv)! Zem0) 22)1Z, bby) 20 | (Zn, hy) > 20)) 
全 else 
(0) | 
本 系统 中 温度 阔 值 Z vv 取 50C ， 湿 度 阔 值 Zu 取 ,| 
80%RH， 罗 辑 值 为 1 的 栅 格 用 黑色 填充 ， 表 示 被 占用 。 E20- 
将 式 (3) 和 式 (6) 结合 使 用 ， 获 得 温度 和 湿度 环境 下 1 中 
格 地 图 ， 分 别 如 图 6 (a) 和 图 6 (b) 所 示 。 温室 中 如 图 1 所 示 外 加 
意 的 作物 区 域 ， 是 阻碍 机 器 人 移动 主要 障碍 ， 也 必须 将 其 反映 8 16 24 2 40 48 56 64 72 80 88 9 
到 栅 格 地 图 中 ， 该 工作 由 人 工 输入 障碍 物 的 坐标 位 置 ， 计 算 机 
7 复合 栅 格 地 图 
经 过 简单 的 处 理 即 可 形成 障碍 物 的 栅 格 地 图 , 如 图 6Cc) 所 示 。 
最 后 ， 利 用 式 (5) 将 温度 栅 格 地 图 、 湿 度 栅 格 地 图 以 及 障 
ee (开始 ) 
碍 物 栅 格 地 图 进行 复合 ， 获 得 完整 信息 的 复合 栅 格 地 图 ， 如 图 
一 一 一 一 一 一 一 一 
7 所 示 Vy 
硅 立 全 < 
图 7 所 表示 的 复合 要 格 地 图 ， 是 根据 传感器 网 络 在 某 次 采 建立 复合 栅 格 地 图 
集 温 度 、 湿 度 环 境 信息 后 绘制 出 来 的 。 理 论 上 传感器 网 络 每 1s v 
ZX > 
采集 一 次 数据 ， 机 器 人 应 该 绘制 出 一 张 复合 栅 格 地 图 ， 但 这 将 0 
en | a 下 
会 大 大 增加 机 器 人 的 负担 ， 导 致 响应 慢 、 实 时 性 差 的 问题 。 系 
统 在 实际 运用 中 ， 采 用 当 采 集 到 温度 或 者 湿度 数据 变化 率 达 到 要 据 变 化 率 超 值 7 一 
土 10% 阔 值 时 ， 则 更 新 整个 温室 复合 栅 格 地 图 ， 并 重新 规划 路 否 
径 ， 其 动态 过 程 如 图 8 所 示 。 
图 8 动态 更 新 复合 栅 格 地 图 


4 ”现场 移动 测试 


4.1 移动 机 器 人 介绍 
本 系统 采用 上 海 英 集 斯 自动 化 技术 有 限 公司 提供 的 轮 式 移 
动机 器 人 作为 开发 测试 平台 ， 其 主要 参数 如 表 1 所 示 。 


本 系统 应 用 的 机 器 人 是 个 具有 多 功能 模块 的 


兵 ， 等 ; 温室 移动 机 器 人 复合 栅 格 地 图 构建 方法 研究 


以 通过 加 载 不 所 


能 , 并 可 将 
并 查看 运行 效果 ， 实 现 再 次 开发 02-14。 
4.2 机 器 人 移动 测试 


的 硬件 模 莫 


自己 所 看 


发 平台 ,下 
kg， 配 合 相应 的 软件 包 ， 实 现 多 种 功 


究 的 算法 或 控制 策略 , 替换 相应 的 软件 包 ， 


体位 置 如 医 


9 所 示 。 


昌 变 化 阔 值 分 别 


格 地 图 ， 具 体 


表 1 移动 机 器 人 参数 在 温室 中 ， 设 定 A(16,4) 点 为 起 始点 ，T1(20,20)， 
项 二 要 参 类 T2(48,20), ...,T10(60,12) 分 别 为 
2 层 结构 ， 工 业 级 嵌入 式 计算 机 (上 移动 机 器 人 采用 广泛 使 用 的 传统 A ”路径 规划 算法 , 进行 路 径 规 
系统 架构 、 有 、 划 [15~18] 
位 机 ) + 运动 控制 卡 ( 下 位 机 ); 8 
Intel PM1. 86G 低 功 耗 、 高 速 处 理 器 ; 
SATA 806 高 速 硬 盘 ，DDR 512M 内 存 ， 人 | 
计算 机 6 个 串口 (包括 485、422 通信 接 2 
口 )，8 个 独立 USB 接口 ，PCI 插 模 ， 24r 
Ss 20. 
双 通 道 RTL8110S 自 适 应 以 太 网 口 ; 16- 
12 
本 专用 高 速 数字 信和 号 处 理 器 (DSP) 8 
运动 控制 卡 4 
TMS320LF2407; or tlirrilirl | | 
0 8 16 24 32 40 48 56 64 72 80 88 96 
尺寸 /重量 495 mm x480 mmx600 mm/30Kg; X/ 
2 图 9 移动 测试 目标 点 位 置 
外 接 电源 DC24V，25A; 
所 机 24V70W MAXON 电机 ， 对 10 个 目标 点 进行 分 组 测试 ， 每 组 分 四 种 情况 ， 分 别 对 
超声 波 、 温 湿度 、 摄 像 头 、 火 焰 传 感 应 : 不 能 更 新 的 普通 栅 格 地 图 和 温度 、 湿 度数 ] 
感 器 。 
人 器 、 烟 雾 传感器 为 土 5%、 土 10%、 土 20% 时 ， 动 态 更 新 的 复合 
数据 如 表 2 所 示 。 
表 2 测试 数据 统计 
是 否 避 开 完成 时 间 /s 
组 数 标 复合 栅 格 地 图 复合 栅 格 地 
普通 栅 格 地 图 普通 栅 格 地 图 
士 5% 土 10% 土 20% 士 2% 十 10% 土 20% 
1 Tl 由 V 也 32.5 52.5 34.1 33.8 
2 到 a ， a ; 38.2 61.1 40.1 39.5 
3 T3 V V V 42.4 67.8 44.5 44.4 
4 T4 x V 81.1 52.6 52.1 
5 T5 x | V ~ 三 85.3 55.3 54.7 
6 T6 x V V ， 112.5 73.0 Wek: 
学 T7 x V V x 137.6 89.6 88.5 
8 T8 x A V 123.4 81.1 80.4 
9 T9 x | x . 132.8 86.2 85.4 
10 TT10 V 到 V V 47.6 76.2 50.1 49.7 
表 2 中 表示 成 功 避 开 ，X 表 示 未 成 功 避 开 。 


从 表 2 中 避 开 障碍 物 的 成 功率 上 看 ， 利 用 普通 栅 格 地 图 避 
开 障碍 物 的 成 功率 为 40%; 利用 温 湿度 数据 变化 率 阔 值 分 别 设 
定 为 土 2%、 土 10%、 土 20% 时 ， 动 态 更 新 的 复合 栅 格 地 图 ， 其 
成 功率 分 别 为 100%、100%、80%。 普通 栅 格 地 图 成 功率 低 是 因 


为 仅 靠 自身 携带 的 传感器 无 法 获得 全 面 的 环境 信息 ， 且 不 更 新 
栅 格 地 图 ， 导 致 路 径 规划 出 现 错误 。 复合 栅 格 地 图 考虑 了 全 而 
的 环境 信息 ， 且 按 条件 更 新 地 图 ， 因 此 成 功率 大 大 提高 。 温 湿 


和 、 变 化 阐 


率 是 因为 ， 数 据 变化 率 阔 值 设 定 过 高 ， 
造成 的 。 
10 中 X 轴 坐 标 
值 为 士 2% 


或 者 说 是 地 区 


度 变化 率 阔 值 设 为 士 20% 时 ， 复 合 栅 格 地 图 出 现 20% 的 不 成 功 


的 复合 栅 格 地 图 、 变 化 
合 栅 格 地 图 和 变化 闹 值 为 土 20% 的 复合 栅 格 划 


更 新 过 慢 


P 的 1、2、3 和 4 分 别 对 应 普通 栅 格 地 


0% 的 复 


表示 完 


成 时 间 。T1、T2、T3 和 T10 分 别 表示 不 同 


标 时 的 完成 时 间 
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线 。 图 10 中 的 完成 时 间 的 变化 趋势 可 以 得 出 , 不 同 目标 对 应 


( 立 
吾 


变 
拟 


2.5 倍 ;基于 复合 栅 格 地 图 运行 时 间 较 之 


时 


呆 


5 


的 
度 
新 


响 
当 
的 
的 


20% 时 , 所 对 


完成 时 间 曲 线 具 有 相似 的 变化 趋势 , 闵 值 绝对 值 为 2%、10%、 
应 的 完成 时 间 均 分 别 是 普通 栅 格 地 图 1.60 倍 、1.05 


、1.05 倍 。 


时 间 /s 


图 10 


测试 完成 时 间 变 化 趋势 


10 可 以 得 出 当 更 新 复合 栅 格 地 图 的 数据 
均 能 成 功 避 开 实际 障碍 物 ， 以 及 模 
， 成 功率 是 基于 普通 栅 格 地 图 的 
基于 普通 栅 格 地 图 运行 
表明 此 种 情况 下 复合 栅 格 地 图 的 更 新 不 会 明 


综合 表 2 和 图 
化 阔 值 设 定 成 士 10% 时 ， 
出 来 的 高 温 、 高 湿度 障碍 区 


[E=3 


su 


间 为 1.05 倍 ， 


影响 机 器 人 的 响应 速度 。 


结束 语 


在 无 线 传感器 网 络 实时 获取 温室 温度 、 湿 度 关键 环境 信息 
基础 上 ， 利 用 阔 值 分 割 和 单元 分 解法 ， 并 通过 设 定 合 适 的 温 
、 湿 度数 据 变化 率 阔 值 ， 实 现 复 合 栅 格 地 图 的 构建 和 动态 更 
。 通 过 测试 表明 ， 当 数据 变化 率 阔 值 设 定 为 土 10% 时 ， 基 于 
合 栅 格 地 图 的 传统 A’ 路 径 规划 均 能 成 功 避 开 障 碍 区 域 , 通过 
普通 栅 格 地 图 比较 ， 基 于 动态 更 新 的 复合 栅 格 地 图 的 机 器 人 
应 速度 并 未 受到 明显 影响 ， 能 满足 系统 的 实际 需求 。 此 外 ， 
有 更 多 的 环境 信息 被 引入 后 ， 复 合 栅 格 地 图 将 包含 更 加 丰 
信息 ， 将 具有 更 高 的 成 功率 。 下 一 步 工作 将 从 更 新 栅 格 地 
局 部 信息 入 手 , 进一步 减 小 机 器 人 运算 工作 量 , 提高 实时 性 。 
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